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Abstract 


Closed  loop  control  of  an  unmanned  underwater  vehicle  (UUV)  in  the  dynamically 
difficult  environment  of  shallow  water  requires  explicit  consideration  of  the  highly 
coupled  nature  of  the  governing  non-linear  equations  of  motion.  This  coupling  between 
an  UUV's  six  degrees  of  freedom  (6  DOF)  is  particularly  important  when  attempting 
complex  maneuvers  such  as  coordinated  turns  (e.g.  simultaneous  dive  and  heading 
change)  or  vehicle  hovering  in  such  an  environment.  Given  the  parameter  and  modelling 
uncertainties  endemic  to  these  equations  of  motion,  then  a  robust  6  DOF  sliding  controller 
employing  six-element  vector  sliding  surfaces  provides  a  framework  in  which  satisfactory 
UUV  control  can  be  achieved  in  shallow  water. 

The  vehicle  equations  of  motion  are  developed  and  cast  in  a  form  that  is  amenable 
to  non-linear  sliding  control  design.  A  complete  6  DOF  sliding  controller  with  vector 
sliding  surfaces  is  then  formulated  via  a  Lyapunov-like  analysis.  The  sliding  controller 
is  then  modified  via  a  weighted  least-squares  approach  to  work  with  a  particular  UUV 
which  has  only  4  DOF  control  authority  available.  The  modified  controller  is  shown  to 
work  well  for  a  variety  of  commanded  UUV  maneuvers  in  the  presence  of  significant 
environmental  disturbances  and  vehicle  hydrodynamic  parameter  uncertainties  via 
numerical  simulation.  Use  of  the  signals  generated  by  the  controller  are  shown  to  be  of 
utility  in  vehicle  buoyancy  control. 

Thesis  Supervisor:    Dr.  Dana  R.  Yoerger,  Associate  Scientist 
Woods  Hole  Oceanographic  Institution 
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Chapter  1 


Introduction 


1.1  Background  and  Objectives 

Unmanned  Underwater  Vehicles  (UUV's)  have  become  increasingly  popular  tools 
for  use  in  a  number  of  ocean  research  and  industrial  applications.  As  the  missions  for 
these  UUV's  expand  in  scope,  their  capabilities  must  also  increase  -  not  only  in  terms  of 
improved  vehicle  control  and  manueverablity  but  also  with  regards  to  satisfactory 
performance  in  challenging  environments. 

For  instance,  consider  the  vehicle  of  figure  1.1  which  is  currently  under 
development  at  the  Naval  Undersea  Warfare  Center  (NUWC)  in  Newport,  Rhode  Island. 
This  301  inch  long,  21  inch  in  diameter  torpedo  shaped  vehicle  -  known  as  the  21UUV 
-  is  being  designed  so  as  to  have  the  capability  to  perform  sophisicated  maneuvers  in  the 
dynamically-challenging  regime  of  shallow  water. 

Needless  to  say,  the  controller  which  enables  this  UUV  to  attain  such  capability 
must  be  fairly  sophisticated  itself.  Not  only  must  the  control  algorithm  be  robust  to  the 
uncertain  and  changing  values  of  the  hydrodynamic  coefficients  which  define  the  vehicle 
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Figure  1.1  21UUV 

non-linear  equations  of  motion,  it  must  be  able  to  account  for  the  dynamic  coupling  that 
will  occur  between  the  vehicle's  various  degrees  of  freedom  as  complex  maneuvers  are 
undertaken  and/or  the  wave  disturbances  are  significant  -  as  they  would  be  in  shallow- 
water. 

Typically,  the  coupling  in  these  non-linear  equations  of  motion  are  subjected  to 
various  simplifying  assumptions  so  that  particular  vehicle  design  objectives  can  be 
satisfied  (e.g.  decoupled  speed  control,  inner  pitch/outer  depth  loop  control,  etc.).  Such 
simplifying  assumptions  also  allow  the  use  of  sliding  controllers  of  first-order  (i.e.  scalar 
sliding  surfaces)  -  a  non-linear  robust  control  methodology  which  has  proven  well-suited 
to  control  in  the  ocean  environment. 

As  alluded  to,  however,  more  demanding  underwater  vehicle  maneuvers  such  as 
hovering  require  careful  consideration  of  the  coupling  inherent  to  the  equations  of  motion. 
Likewise,  the  operation  of  such  a  vehicle  in  the  dynamically  difficult  regime  of  shallow 
water  necessitates  a  thorough  accounting  of  this  coupling  if  high  performance  is  to  be 
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acheived.  As  will  be  demonstrated,  a  complete  6  DOF  sliding  controller  (i.e.  a  6  element 
vector  sliding  surface)  provides  an  effective  framework  for  handling  these  situations. 

This  study  focused  on  the  development  of  a  six  degree  of  freedom  (6  DOF)  robust 
sliding  controller  to  be  used  on  a  variety  of  UUV  designs  in  dynamically  difficult  regimes 
like  shallow  water  as  well  as  for  complicated  maneuvering  such  as  hovering.  As  few 
practical  UUV's  have  the  6  or  more  controllable  degrees  of  freedom  a  method  is  presented 
which  modifies  the  6  DOF  control  signal  so  that  a  4  DOF  control  authority-available 
vehicle  such  as  the  21  UUV  can  reap  the  benefits  of  a  complete,  coupled  non-linear 
controller. 

A  side  benefit  of  the  6  DOF  sliding  controller  is  that  it  produces  a  signal  which 
is  ideal  for  use  in  buoyancy  control  systems.  In  addition,  mention  is  made  as  to  how 
disturbance  adaptation/control  might  be  formulated  with  the  6  DOF  controller. 

1.2  Thesis  Outline 

Chapter  2  details  the  development  of  the  general  non-linear  and  coupled  6  DOF 
UUV  equations  of  motion.  These  equations  are  formulated  with  respect  to  two  reference 
frames  -  vehicle-fixed  and  earth  (inertial)-fixed  -  and  in  such  a  format  that  readily  lends 
itself  to  non-linear  controller  design  techniques  as  outlined  in  chapter  3.  Key  matrix 
relationships  that  characterize  resultant  UUV  equations  of  motion  are  described,  as  these 
form  the  basis  of  the  robust  non-linear  sliding  controller.  The  sources  and  values  of  the 
various  body  and  hydrodynamic  coefficients  for  the  21  UUV  of  figure  1.1  which  will  be 
used  in  the  numerical  simulations  of  Chapters  3,  4  and  5  are  also  summarized. 
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Chapter  3  presents  the  formulation  of  the  complete  6  DOF  robust  sliding  controller 
which  is  shown  to  be  stable  -  assuming  full  6  DOF  control  authority  -  from  any  vehicle 
configuration  except  at  ±  90  degrees  of  pitch. 

As  full  6  DOF  control  authority  is  usually  not  available,  an  attempt  is  made  in 
Chapter  4  to  develop  a  method  to  modify  this  sliding  controller  so  that  lesser  degree  of 
freedom  vehicles  (in  terms  of  available  control  authority)  would  perform  satisfactorily. 
As  is  demonstrated  with  the  4  DOF  21UUV,  this  method  -  weighted  least  squares  -  is 
based  heavily  on  the  non-minimum  phase  relationship  between  pitch/depth  and 
yaw/trackline.  Extensive  simulations  are  presented  to  evaluate  the  effectiveness  and 
validity  of  this  method. 

Chapter  5  briefly  delves  into  two  areas  related  to  the  controller  development  of 
the  previous  chapters  -  vehicle  buoyancy  control  and  wave  disturbance  rejection/control. 
The  earth-referenced  vehicle  control  signal  generated  by  the  sliding  controller  of  Chapter 
3  is  shown  by  computer  simulations  on  the  21UUV  to  be  of  great  utility  as  an  input  to 
a  variable  buoyancy  control  system.    Vehicle  response  in  a  wave  field  is  simulated. 

Chapter  6  summarizes  the  results  of  this  thesis  and  suggests  directions  for  further 
investigation. 
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Chapter  2 


6  DOF  Rigid  Body  Equations  of  Motion 


2.1    General  Discussion 

In  this  chapter  the  6  DOF  rigid  body  underwater  vehicle  equations  of  motion  are 
developed  with  the  primary  emphasis  being  the  identification  of  a  particularly  compact 
and  convenient  way  to  express  them  for  exploitation  by  nonlinear  sliding  controller  design 
techniques  as  outlined  in  chapter  3. 

Section  2.2  introduces  the  standard  notation  and  conventions  utilized  in  underwater 
vehicle  design.  The  two  reference  frames  commonly  used  to  describe  the  motion  of  and 
forces/moments  on  the  vehicle  -  body-fixed  and  earth-fixed  (inertial)  -  are  introduced  as 
well.  It  is  of  considerable  importance  to  both  the  development  of  the  equations  of  motion 
and  to  the  subsequent  6  DOF  sliding  controller  formulation  that  the  two  reference  frames 
and  the  relationship  between  them  are  thoroughly  understood.  As  might  be  expected  from 
physical  intuition,  the  vehicle  linear  and  angular  velocities  and  corresponding 
accelerations  along  with  the  vehicle  external  forces  and  moments  are  best  described  in  the 
body-fixed  frame;  whereas,  the  vehicle's  linear  and  angular  positions  are  best  described 
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in  an  inertial  reference  frame  in  which  commanded  trajectories  are  typically  expressed. 
For  small  angle,  non-coupled  vehicle  maneuvers  the  distinction  between  the  reference 
frames  is  slight  and  can  be  safely  ignored.  However,  for  more  vigorous,  coupled 
maneuvers  (e.g.  a  coupled  dive/trackline  commanded  trajectory  or  hovering)  and/or  for 
operation  in  the  more  dynamically-challenging  environment  of  shallow  water,  this 
distinction  must  be  preserved. 

With  this  last  point  in  mind,  the  full  6  DOF  underwater  vehicle  equations  of 
motion  are  derived  in  the  body-fixed  reference  frame  in  section  2.3.  The  resultant 
equations  are  parameterized  in  a  specific  matrix  form  which  turns  out  to  be  particularly 
amenable  to  sliding  controller  design.  The  full  6  DOF  earth-fixed  and  body-fixed 
nonlinear  UUV  equations  of  motion  are  summarized  in  (2.26)-(2.28). 

The  final  section  of  this  chapter  summarizes  the  values  of  the  hydrodynamic 
coefficients  used  in  these  equations  of  motion  and  how  they  were  determined. 

2.2   Standard  Notation  and  Reference  Frames 

For  (rigid  body)  underwater  vehicles  which  operate  in  a  three  dimensional  space, 
it  is  necessary  to  describe  the  position/orientation  and  motion/rotation  of  the  vehicle  by 
six  independent  coordinates  -  hence,  the  term  six  degree  of  freedom  (6  DOF).  Typically 
these  coordinates  are  chosen  to  correspond  to  the  position  and  orientation  and  their  time 
derivatives  with  respect  to  some  set  or  sets  of  mutually  orthogonal  coordinate  axes  (e.g. 
x-,  y-,  z-axes)  fixed  to  some  arbitrary  origin  which  defines  a  reference  frame.  Likewise, 
the  forces/moments  acting  on  or  produced  by  the  vehicle  can  be  referenced  to  a  set  of 
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coordinate  axes.   Standard  (SNAME  [1950])  notation  is  used  in  this  study  to  describe  the 
aforementioned  6  DOF  quantities  and  is  summarized  in  Table  2.1. 


DOF 

Motions 

Forces  and 
Moments 

Linear  and 
Angular  Vel. 

Positions  and 
Euler  Angles 

1 

surge 

X 

u 

X 

2 

sway 

Y 

V 

y 

3 

heave 

Z 

w 

z 

4 

roll 

K 

p 

4> 

5 

pitch 

M 

q 

0 

6 

yaw 

N 

r 

M> 

Table  2.1  -  Standard  Underwater  Vehicle  Notation 

Note  that  by  convention  for  underwater  vehicles,  the  positive  x  direction  is  taken 
as  forward,  the  positive  y  direction  is  taken  as  to  the  right,  the  positive  z  direction  is 
taken  as  down,  and  the  right-hand  rule  applies  for  angles.  It  is  convenient  to  group  the 
linear  and  angular  velocities  as  a  vector  quantity  v,  where: 


v  =  [u  v  w  p  q  r\ 


the  positions  and  Euler  angles  as  a  vector  quantity  r),  where: 


tj  =  [x  y  z  <|>  6  i|r]J 


and  the  forces  and  moments  as  a  vector  quantity  x,  where: 


x  =  [X  Y  Z  K  M  Nf 


(2.1) 


(2.2) 


(2.3) 


As  previously  indicated,  it  is  not  necessary  to  choose  the  same  reference  frame  for 
the  three  quantities  of  (2.1)-(2.3).    In  fact,  it  is  customary  and  makes  physical  sense  to 
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refer  v  and  t  to  the  vehicle-fixed  (body)  reference  frame  and  to  refer  r)  to  an  inertial 
reference  frame.  Note  that  choosing  these  particular  frames  of  reference  directly 
influences  the  form  of  the  6  DOF  equations  of  motion  that  are  to  be  developed.  The 
body-fixed  reference  frame  is  chosen  to  coincide  with  the  vehicle's  principle  axes  of 
inertia.  The  earth  is  chosen  as  the  inertial  reference  frame  since  underwater  vehicles 
travel  at  low  enough  speeds  so  that  the  acceleration  of  points  on  the  surface  of  the  earth 
can  be  neglected. 

As  it  will  be  necessary  to  convert  from  one  reference  frame  to  the  other,  a 
relationship  between  v  and  r|  for  the  particular  positive  axis  directions  that  have  been 
defined  can  be  shown  to  be  (see  Fossen  [1994]): 


T|   =  J(ti)  V 


(2.4) 


where: 


JW  - 


0  J2(T]2) 


(2.5) 


and  (s=sin,  c=cos,  f=tan): 


•w 


C1JJC0     -5ll/C(J)  +Cl|X505(p      5lj/5(t)+Cl|JC(j)56 
StycO       CTj/C(j)+5(t)505l|;       -C\J/5(j)+505l|JC(J) 
-50  C05(J)  C0C(j) 


(2.6) 


and: 
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•AOh) 


1 

54>f0 

cfytd 

0 

c4) 

-5(J) 

0 

s$/cQ 

c<b/cQ 

(2.7) 


Specifically,  (2.5)  represents  a  series  of  three  rotations  -  about  the  yaw  angle  then  the 
pitch  angle  then  the  roll  angle  -  to  get  from  the  vehicle-fixed  reference  frame  to  the  earth- 
fixed  reference  frame. 

Note  that  (2.7)  is  undefined  for  pitch  angles  of  ±  90  degrees.  To  overcome  this 
problem,  one  can  use  a  quaternion  representation  to  describe  the  coordinate  axis  rotations 
implied  by  (2.5)  -  see  Fossen  [1994]  -  or  one  could  define  a  second  body-fixed  reference 
frame  (different  from  the  first)  and  switch  to  its  use  when  approaching  the  singular 
orientations  of  the  first  reference  frame.  Fortunately,  vehicle  metacentric  restoring  forces 
and  typical  commanded  vehicle  trajectories  preclude  operation  near  these  singularities  so 
(2.4)-(2.7)  are  considered  adequate  for  the  purposes  of  this  study. 

2.3   Equations  of  Motion 

Derivation  of  the  underwater  vehicle  equations  of  motion  has  been  extensively 
studied  over  the  years  and  can  be  accomplished  by  a  number  of  techniques  (e.g.  Newton- 
Euler,  Kirchoff,  Lagrangian).  This  paper  will  briefly  present  the  results  of  a  Newton- 
Euler  formulation  so  that  the  final  form  of  the  equations  of  motion  and  that  some 
assumptions  utilized  in  the  sliding  controller  design  are  made  clear.  The  interested  reader 
is  encouraged  to  consult  a  suitable  hydrodynamic  treatise  (e.g.  Fossen  [1994])  for  a  more 
complete  treatment  of  this  subject. 
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It  is  extremely  desirable  to  derive  these  equations  of  motion  in  a  body-fixed 
reference  frame  so  that  the  hydrodynamic  and  kinematic  forces  and  moments  remain 
constant  despite  changes  in  the  vehicle's  orientation  with  respect  to  the  earth-fixed 
reference  frame.     From  Newton's  Second  Law: 

mv=f  (2-8) 

where: 

m  =  vehicle  mass 

v  =  acceleration  vector  (2-9) 

/  =  force  vector 

it  is  apparent  that  the  decision  to  formulate  the  equations  of  motion  in  the  body-fixed 
reference  frame  trades  off  complexity  in  the  acceleration  terms  for  relative  simplicity  in 
the  force  terms.  With  this  in  mind,  conservation  of  linear  momentum  for  a  rigid  body 
yields  (Euler's  First  Axiom  of  Newton's  Second  Law): 

m(vo  +  coxvo  +  6xrG  +  a  x  (id  x  rG))  =  f0  (2.10) 

where: 


m  =  vehicle  mass 

(o  =  angular  velocity  vector 

6  =  angular  accleration  vector 

vo  =  vehicle  body  referenced  vel.  (2.11) 

v  =  vehicle  body  referenced  ace. 

rG  =  vector  origin  o  -  center  gravity  G 

f  =  external  force  vector 

In  a  similar  manner,  conservation  of  angular  momentum  yields: 
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/_«  +  (o  x  (/a))  +  m/>  x(v+a>xv)=m 


(2.12) 


where: 


70  =  body  inertia  tensor 
m    =  applied  moment  vector 


(2-13) 


Combining  (2.10)  and  (2.12)  results  in  (after  some  judicious  rearrangement  of  terms): 


MRB*     +    CKfl(V)V     =    * 


RB^ 


*RB 


(2.14) 


where,  assuming  the  x-,  y-  and  z-  body  axes  correspond  to  the  longitudinal,  lateral  and 
normal  symmetry  axes  of  the  vehicle  (so  all  cross-inertia  terms  are  zero  -  usually  an 
excellent  supposition  and  especially  so  for  the  21UUV  of  figure  1.1)  and  assuming  the 
lateral  center  of  gravity  corresponds  to  the  lateral  axis  origin  (yG  equals  zero  -  again,  an 
excellent  assumption): 


and: 


M 


RB 


m  0 

0  m 

0  0 

0  -mz 


8 


0 
0 
m 
0 


mz        0       ~mxn 


g 


0      mx„ 


0 


0 

-mzg 
0 

h 

0 

0 


nZ8 

0 

0 

*** 

mxg 

0 

0 

0 

y 

0 

0 

h. 

(2.15) 
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C„(v)  = 


0 

0 

0 

ntZfJ- 

-/n(x^-w) 

-mCXgT  +  v) 

0 

0 

0 

-mw 

mizQT+XcP) 

mu 

0 

0 

0 

-mticP  - 

v) 

-miztf  +  u) 

mxj 

-mzGr 

mw 

mizQp-v) 

0 

1/ 

-** 

m{xGq-W) 

-m{zGr+xGp) 

mdcq  +  u) 

-v 

0 

Ij> 

m(xcr  +  v) 

-mu 

-mXoP 

¥ 

"^ 

0 

(2.16) 


and: 


xRR  =  [X  Y  Z  K  M  Nf 


(2.17) 


Note,  that  the  rigid-body  inertia  matrix  M^  is  symmetric,  positive-definite  (i.e. 
MAS=(A/^g)T  >  0)  and  time-invariant,  whereas  the  rigid-body  Coriolis  and  centripetal 
matrix  Cm(\>)  is  skew-symmetric  (i.e.  CRB(v)=-{CRB(v))T  V  v  e  $R6).  Both  facts  will  be 
useful  in  the  6  DOF  sliding  controller  design. 

The  generalized  vector  of  external  forces  and  moments  x^  can  be  expressed  as  the 
sum  of  radiation  induced  forces  xR  (e.g.  added  mass,  potential  damping  and  restoring 
forces),  viscous  damping  forces  xv ,  environmental  forces  (such  as  waves  and  current)  and 
propulsion  forces  x.  Ignoring  the  latter  forces  (for  now)  and  adopting  the  treatment  of  xR 
and  xv  suggested  by  Fossen  [1991]  yields: 


*r=      -MAv-CA(v)v    -Dp(v)v      -g(n) 
added  potential     restoring 

mass  damping       forces 


(2.18) 


and: 


xv  =  -Dv(v)v 


(2.19) 


Assuming  the  vehicle  has  bottom/top  and  port/starboard  symmetry  (which  the 
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21UUV  of  figure  1.1  has),  the  added  inertia  matrix  MA  and  the  hydrodynamic  Coriolis 
and  centripetal  matrix  CJy)  can  be  written  as  (see  Faltinsen  [1990]): 

X.    0      0      0      0     0 

o  r,  o    o    o   r, 


and: 


M. 


0    0    z. 


o    z •    0 


0     0     0^00 

0     0    Mw    0    M .    0 
0    N.     0      0     ON. 


(2.20) 
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0 
0 


-c 


15 

16 


0 
0 
0 

c 

0 


,24 


-c;°  -c 


26 


0 
0 
0 

-c 

-cA 

0 


34 

35 


0 


c 
cA 

0 


24 
34 


-c 


45 
/I 

46 


,15 
■A 

0 

35 


/I 

45 
A 

0 


-cr  -c 
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-,15 
"A 

-,26 
-M 

0 


c5 

^A 
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(2.21) 


where: 


,15 


16 


C?  =  -Z^w-Z-q    C?  =  Y,v  +  Y, 


C 

c 
c 


24 

A 

34 

A 

45 


Z.w+Z.q  Cj6  =   -XAU 

-Y,v-Yfr  Cj5  =X,.M 

-r,v-2V/  Cf  =Z.w+M.q 

,56 


c: 


■V 


(2.22) 


The  hydrodynamic  coefficients  in  (2.20)  and  (2.22)  follow  the  standard  notation  of 
SNAME  [1950].   Refer  to  Appendix  I  for  further  details. 
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Note  that  for  a  submerged  rigid-body  vehicle  moving  in  still  water  under  the 
assumption  of  an  ideal  fluid,  MA  is  always  positive  definite  (same  condition  as  MliH)\  a 
condition  which  is  also  almost  invariably  met  for  submerged  vehicles  in  real  fluids  (see 
Wendel  [1956]  or  Newman  [1977],  for  example).  Similar  properties  hold  for  CA(v)  -  i.e. 
for  nearly  all  real  fluid  conditions  CJy)  is  skew-symmetric  (like  Cm(v))  -  see  Sagatun 
and  Fossen  [1991]. 

The  potential  damping  term  Dp(v)  is  usually  quite  small  for  underwater  vehicles- 
especially  for  operations  away  from  the  surface  wave  zone.  Consequently,  these  effects 
are  ignored  for  this  analysis.  Even  if  this  term  was  numerically  significant,  it  is 
dissipative  by  definition  which  implies  that  Dp(v)  is  positive  definite  (i.e.  vTDp(v)v  >  0 
V  v  *  0)  -   an  important  fact  in  the  development  of  the  6  DOF  sliding  controller. 

By  the  same  dissipative  nature  of  the  linear  skin  friction  and  quadratic  vortex- 
shedding  drag  forces  which  constitute  the  viscous  damping  matrix  Dv(v),  it  also  is  always 
positive  definite.    The  following  form  for  this  matrix  is  chosen  to  be: 


0y(v)    = 


0 

0 
0 
0 
0 


0 
0 
0 


wq- 

0 

0 

M... 


N..       0 


0 

0 

0 

0 

0 

Y 

r 

0 

z, 

0 

KP 

0 

0 

0 

Mq 

0 

0 

0 

Nr. 

(2.23) 


The  terms  on  the  diagonal  of  (2.23)  represent  the  drag  generated  along  the  ;'th 
DOF  for  motion  in  the  rth  DOF;  the  off-diagonal  X  coefficients  -  Xvr  and  Xwq  -  represent 
the  loss  in  forward  speed  generated  in  a  turn  and  in  a  depth  change,  respectively;  and  the 
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remaining  off-diagonal  terms  capture  the  coplanar  drag  generated  in  turns  and/or  depth 
changes.  Coplanar  refers  to  coupled  DOF's  like  pitch-depth  which  naturally  occur 
together  in  typical  vehicle  maneuvers. 

Other  terms  could  be  inserted  into  (2.23)  such  as  K^r  (a  wow-coplanar  coefficient) 
-  however,  (2.23)  characterizes  the  vast  majority  of  the  dissipative  forces  encountered 
during  typical  maneuvers  for  vehicles  such  as  the  21UUV  of  figure  1.1  (see  Humphreys 
[1989]).  Those  terms  that  are  ignored  do  not  affect  the  positive  definite  quality  of  the 
matrix  since  damping  forces  by  definition  are  dissipative. 

The  restoring  force  vector  g(r\)  consists  of  the  gravitational  forces  acting  at  the 
center  of  gravity  (xG=[xG,yG,zG]T)  and  the  buoyant  forces  acting  at  the  center  of  buoyancy 
(x^lxp  y&  zB]T)  and  has  the  form  (assuming  both  yG  and  yB  zero): 


(W-B)sd 
-(W-B)cQs$ 

-(W-B)cQc<$> 
(zGW-ZBB)cds<b 

(zgW-ZbB)sQ  +  fr0W-xJB)t&c$ 

~(xGW-x^B)cQs^ 


g(vi)  = 


(2.24) 


Defining: 


M  =  MRB+MA;  C(v)  =  C(v)^  +  CA(v)  ;  D(v)  =  Dp(v)+D^v)      (2.25) 


Then  the  combination  of  equation  (2.14)  and  (2.25)  yields  the  bodv-fixed  6  DOF 
representation  of  the  non-linear  equations  of  motion  for  underwater  vehicles: 
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Mv  +  C(v)v  +  Z)(v)v  +  g(r\)  =  x  (2.26) 

To  obtain  the  earth-fixed  6  DOF  representation  of  the  non-linear  equations  of  motion  for 
underwater  vehicles,  the  transformation  of  (2.4)  must  be  applied  to  (2.26)  yielding: 

M^Vi)*\  +  C,0M|M  +  Zyv^r,   +  gn(T!)  =  x,,  (2.27) 

where: 

M^)-J-T(r\)MJ-\r\) 
Cn(v,Ti)  =J-r(t1)[C(v)  -MJ-\rfi /(il)]/-1^) 
Dn(v,i1)=J-r(T1)D(v)J-1(i1)  (2-28) 

^(Tl)  =/-T(tl)^(il) 

T1|(tl)=J-r(ll)T(TI) 

(2.26)-(2.28)  are  used  extensively  in  the  implementation  of  the  6  DOF  sliding  controller. 

2.3.1    Notes  on  the  Matrices  in  the  Equations  of  Motion 

Note  that  M  and  D(v)  are  positive  definite  since  they  are  the  sum  of  positive 
definite  matrices  and  that  C(v)  is  skew-symmetric  since  it  the  sum  of  two  skew-symmetric 
matrices.  From  (2.28),  it  is  straightforward  to  demonstrate  that  for  nonsingular  J(r\), 
Mn(r|)  and  Z>n(v,r|)  are  also  positive  definite,  though  Cn(v,r|)  is  not  skew-symmetric  in 
general  (see  Fossen  [1994]). 

Another  useful  matrix  relationship  in  the  development  of  the  6  DOF  sliding 
controller  is: 


M  -  2C(v) 


(2.29) 
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Assuming  that  M  is  equal  to  zero  -  i.e.  the  added  mass  terms  in  M  are  independent  of 
wave  frequency  and  thus  vehicle  speed  -  then  it  is  apparent  that  (2.29)  is  a  skew- 
symmetric  matrix1.    Applying  the  transformations  of  (2.28)  to  (2.29)  reveals  that: 

M    -  2C^v,r\)  (2-30) 

is  also  skew-symmetric.    This  last  term,  which  is  analogous  to  the  matrix: 

H(q)  -  2C(q,q)  (2-31) 

in  robotic  manipulator  control  (see  Slotine  and  Li  [1991])  -  which  can  be  proved  to  be 
skew-symmetric  and  represents  in  matrix  form  conservation  of  energy  in  the  manipulator2 
-  plays  an  important  role  in  the  6  DOF  sliding  controller  formulation. 

2.4   Hydrodynamic  Coefficients 

Appendix  I  contains  a  summary  of  the  body  hydrodynamic  coefficients  identified 
in  the  equations  of  this  chapter  for  the  21UUV  of  figure  1.1.  The  coefficients  are  the 
result  of  a  combination  of:  1)  slender-body  (strip)  theory  calculations;  2)  aerodynamic 
lift  and  drag  calculations;  3)  comparison  with  a  similar  UUV  upon  which  extensive 
computer  modeling  was  performed  (see  Humpheys  [1989]);  and  4)  tow-tank  experiments 
made  on  a  scale-model  of  the  21  UUV  (see  Willy  [1994]  for  a  more  complete  accounting 


'Actually  the  added  mass  terms  in  M  vary,  albeit  slightly,  with  varying  sea  conditions. 
This  relationship  is  not  known  in  general  for  each  sea  condition  in  9?6. 

2H{q)  is  the  manipulator  inertia  matrix,  C(q,q)  is  the  centripetal  and  Coriolis  matrix 
and  q  is  the  vector  of  joint  angles.  The  fact  that  (2.31)  is  skew-symmetric  lends  some 
credence  to  the  assumption  that  (2.29)  and  (2.30)  are  skew-symmetric  . 
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of  these  body  and  hydrodynamic  coefficients). 

As  is  well  known,  many  of  these  coefficients  vary  significantly  with  Reynolds 
number  and  thus  with  vehicle  speed.  In  addition,  imperfect  knowledge  of  the  exact  effect 
various  vehicle  components  such  as  fins  and  propulsor  shrouds  have  on  these  coefficients 
over  the  range  of  vehicle  speeds  is  had.  Thus,  a  great  deal  of  uncertainty  exists  in  the 
stated  values  of  body  and  hydrodynamic  coefficients  -  a  large  reason  why  robust  control 
techniques  such  as  sliding  control  are  popular  with  underwater  vehicles.  As  indicated  in 
Appendix  I,  5%  uncertainty  in  the  body  coefficients  and  a  20%  uncertainty  in  the 
hydrodynamic  coefficients  were  assumed.  These  uncertainties  were  used  to  differentiate 
the  "true"  vehicle  model  from  the  "estimated"  vehicle  model  for  simulation  purposes  in 
addition  to  their  use  in  the  actual  design  of  the  sliding  controller. 
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Chapter  3 


6  DOF  Sliding  Controller 


3.1    General  Discussion 

The  use  of  nonlinear  sliding  control  design  to  maintain  stability  and  to  ensure 
consistent  performance  despite  the  significant  parameter  and  modeling  uncertainties  that 
characterize  UUV  design  has  been  effectively  employed  for  a  number  of  years  (e.g. 
Yoerger  et  al  [1986],  Dougherty  and  Woolweaver  [1990],  Hills  and  Yoerger  [1994]).  As 
demonstrated  in  the  previous  chapter,  these  vehicle  equations  of  motion  are  highly 
coupled  and  nonlinear  and  consequently  are  often  subjected  to  various  simplifying 
assumptions  to  meet  various  design  objectives  (e.g.  decoupled  speed  control,  inner 
pitch/outer  depth  loop  control,  etc.).  Such  assumptions  reduce  the  number  of  control 
inputs  that  have  to  be  considered  for  the  simplified  problem  at  hand  to  one,  allowing 
scalar  sliding  surface  controller  theory  to  be  used.  This  theory  is  briefly  summarized  in 
section  3.2  to  highlight  some  of  the  more  important  points  of  sliding  control. 

More  demanding  underwater  vehicle  maneuvers  such  as  hovering  or  operation  in 
the  dynamically  difficult  regime  of  shallow  water,  however,  require  careful  consideration 
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of  the  coupling  between  the  various  control  inputs  inherent  in  the  equations  of  motion. 
Scalar  sliding  control  becomes  less  satisfactory  for  such  complex  demands  on  the  vehicle 
and,  instead,  a  complete  6  DOF  sliding  controller  (i.e.  a  6  element  vector  sliding  surface) 
should  be  considered  which  can  handle  the  coupling  between  the  various  controls.  Such 
a  controller  is  developed  in  section  3.3  and  Appendix  II. 

The  resultant  6  DOF  controller  is  then  tested  by  computer  simulation  as 
summarized  in  section  3.4  with  the  very  restrictive  assumption  that  the  6  DOF 
commanded  control  vector  produced  by  the  sliding  controller  can  be  generated  by  the 
vehicle.    This  assumption  is  relaxed  in  chapter  4. 

3.2    Scalar  Sliding  Control 

Consider  a  single-input  dynamic  system  of  the  form: 

where  scalar  x  is  the  output,  x  is  the  state  vector,  and  scalar  u  is  the  input.  Defining  the 
tracking  error  vector  to  some  desired  trajectory  vector  xd  as: 

x  =  x  -  xd  (3-2) 

and  defining  a  time-varying  surface  <S(t)  in  the  state  space  by  the  scalar  equation  .s(.x:;t)=0 
where: 

s(x;t)  =  (— +  A.)"  'x  ;  X>0  (3-3) 

dt 

then  (assuming  the  initial  tracking  error  is  zero)  the  n-th  order  tracking  problem  of  (3.1) 
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and  (3.2)  is  equivalent  to  remaining  on  the  surface  S(t)  for  all  t  >  0  -  i.e.  have  effectively 
reduced  the  n-th  order  tracking  problem  to  a  first-order  stabilization  problem  in  the  scalar 
s.   By  choosing  the  input  u  so  that  outside  S(t): 

--s2  <;  -r\\s\  ;  r,  >0  (3.4) 

it  can  easily  be  demonstrated  (see  Slotine  and  Li  [1991],  for  example)  that  the  surface  S(\) 
will  be  reached  in  a  finite  time  less  than  s  I  (t=0)  |/n;  whereupon  the  tracking  error  will 
decrease  exponentially  to  zero.  (3.4)  is  referred  to  as  the  sliding  condition  and  it  is 
possible  to  choose  the  control  input  u  such  that  (3.4)  is  met  even  in  the  presence  of 
parameter  uncertainties  or  unstructured  uncertainties  in  the  dynamics.  This  is  why  sliding 
control  is  so  useful  for  UUV  controller  design;  not  only  can  it  handle  non-linearities,  but 
a  degree  of  robustness  can  be  factored  into  the  controller. 

3.3    Vector  Sliding  Control 

To  capture  the  full  power  of  sliding  control  theory  for  an  UUV  intended  to  operate 
in  shallow  water  or  designed  to  perform  complex  maneuvers  such  as  hovering,  it  is 
necessary  to  expand  scalar  sliding  control  to  vector  sliding  control.  Fortunately,  as  has 
been  alluded  to,  the  particular  structure  of  (2.26)  and  (2.27)  make  the  development  of  the 
6  DOF  sliding  controller  a  relatively  straightforward  task.  The  derivation  that  follows  is 
analogous  to  the  multi-input,  multi-output  (MIMO)  robust  robot  trajectory  controller 
outlined  in  Slotine  and  Li  [1991]  and  is  similar  to  the  adaptive  MIMO  sliding  controller 
discussed  in  Fossen  [1994]. 
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In  the  6  DOF  sliding  controller,  the  tracking  dynamic  variable  s  of  the  SISO 
sliding  controller  is  replaced  by  a  6-element  vector  s  which  is  defined  as: 


S    =fj+Afj    =T)-Tlr 


(3.5) 


where: 


*1    =    V  ~  Tld  J    T)r    =    TJ,,  "  Ail 


(3.6) 


and  where: 


A  =  control  bandwidth  matrix  (A=Ar  >  0) 
r\d  =  desired  earth -fixed  trajectory 

r\r  =  reference  earth -fixed  trajectory 


(3.7) 


The  control  bandwidth  matrix  is  discussed  in  section  3.4.  The  reference  (or  virtual) 
trajectory  is  merely  a  notational  manipulation  which  transforms  the  energy-related 
properties  of  the  vehicle  (in  terms  of  r\)  into  trajectory  control  properties  (in  terms  of  s). 
Defining  the  Lyapunov  function: 


V(t)  -  V2STM^s  >  0 


Differentiating  (3.8)  and  substituting  the  derivative  of  (3.5)  yields: 


(3.8) 


V(t)=  =  s  T(M^r\  -  M^T\r)  +  V2S  TM^s  (3-9) 

Noting  that  the  system  dynamics  (2.27)  can  be  rewritten  by  means  of  (3.5)  as: 


Mn*i  =  s-(C,+D^d+W-*f 


(3.10) 


Then  (3.9)  can  be  recast  as: 
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V(t)  =  s  r(xn  -  M^r  -  [C,  +  Z>n]f)r  -gj-s  TDj  (3.H) 

Where  the  fact  that  the  quantity: 

M  -2C    is  skew  symmetric  V  r\  (3-12) 

is  used  to  eliminate  the  expression: 

sr(Mn  -ICJs  (3-13) 

See  Fossen  [1994]  and  Slotine  and  Li  [1991]  -  the  latter  in  the  context  of  robot 
manipulators  -  for  explanation/"proof;  this  term  expresses  the  matrix  form  of  the 
conservation  of  energy  in  the  system.   The  skew-symmetry  of  (3.12)  has  been  discussed 
previously  in  Chapter  2. 
Then,  choosing  the  control  law  as: 

x^  =  \-Kri)sgn{*)  (314) 

With: 

*,    =^A  +  (<VA,)*lr+S  (3'15) 

Where  k(r[)sgn(s)  is  defined  as  the  vector  of  components  k,(ri)5g«(s,)  and  where  the 
estimated  (hat)  system  matrices  are  linearly  related  to  the  actual  plant  matrices  by  error 
(tilde)  matrices,  for  example: 

M    =  M    -  M  (3-16) 

inn 

Thus  (3.14)  is  the  control  input  which  would  make  (3.11)  equal  to  zero  if  the  vehicle 
dynamics  were  exactly  known.    Then  the  Lyapunov  function  time  derivative  becomes 
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with  the  use  of  (3.14): 


m  =  »1W,flr  +  (A,+^r+#J-E*i(ii)kil  *r*V        (317) 


6 

I 

«  =  1 

Choosing  k/r[)  such  that: 


W  *  ltfr,flr  +  tf,+^+IJil +  e« ;  e,>0  (318) 

Ensures: 

V{t)  ±  (-J>.|s.|  -srZ)s)  *0  (319) 

Thus  this  6  DOF  sliding  controller  is  asymptotically  stable  from  anywhere  in  the  state 
space  (except  for  at  pitch  angles  of  ±  90  degrees)  as  demonstrated  in  Appendix  II.  Note 
the  dissipative  nature  of  the  drag  matrix  actually  causes  the  system  to  reach  the  desired 
trajectory  faster  than  if  it  did  not  exist. 

As  formulated  above,  the  6  DOF  sliding  controller  is  a  switching  or  chattering 
controller;  resulting  in  very  high  control  action  and  probable  excitation  of  unmodelled 
vehicle  dynamics.  As  indicated  in  Slotine  and  Lee  [1991],  this  potential  problem  can  be 
avoided  by  the  modification  of  the  control  law  (3.14)  to  include  a  smoothing  term  near 
the  switching  surface  characterized  by  a  boundary  layer  thickness  (j),,  The  control  law 
becomes: 

x.    =  t.  -kfrOsatA  (3-20) 

The  inclusion  of  this  boundary  layer  effectively  trades-off  some  tracking  precision  for 
some  robustness  to  unmodelled  dynamics.   By  making  the  boundary  layer  time-varying: 
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\  =  VW^x)  (321) 

where: 

*fiti  =  kfij)  -  *,.  (3-22) 

and: 

<t>,  =  kfitf  -  Xfy  (3-23) 

some  of  the  tracking  precision  can  be  regained.  See  Slotine  and  Li  [1991]  for  a  more 
complete  discussion  on  smoothing  out  the  control  discontinuity  of  (3.14).  All  simulations 
in  this  study  utilize  the  smooth  (sat)  vector  sliding  controller  with  the  values  for  the 
boundary  layer  thickness  (j),'s  chosen  as  .  1  for  all  DOF's  (this  value  seemed  to  yield  good 
control  signals  in  terms  of  smoothness). 


3.4    Simulations 

In  order  to  implement  the  6  DOF  sliding  controller  that  was  designed  in  the 
previous  section,  it  must  be  noted  that  the  controller  was  developed  in  the  earth-fixed 
frame  of  reference.  In  one  sense,  this  is  desirable  as  the  desired  trajectories  (e.g. 
executing  a  trackline  change)  are  usually  earth-fixed  in  nature.  However,  the  state 
measurements  are  made  and  the  commanded  control  actions  are  carried  out  in  the  vehicle 
reference  frame.  Thus,  the  controller  implementation  logic  should  go  something  like:  get 
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the  vehicle-fixed  velocities/accelerations  in  all  6  DOF1;  compute  the  body-referenced 
matrices  of  (2.26);  convert  the  body-reference  matrices  to  earth-referenced  matrices  by 
use  of  (2.28);  get  desired  earth-referenced  control  vector  from  the  sliding  controller;  then 
compute  the  desired  vehicle-referenced  control  vector  using  (2.28).  In  this  section,  the 
assumption  is  made  that  the  desired  vehicle-referenced  control  vector  is  instantly  produced 
in  all  6  DOF's  by  the  vehicle  control  system  -  more  realistic  scenarios  are  examined  in 
the  next  chapter. 

A  comment  on  the  bandwidth  matrix  A.  As  discussed  in  Slotine  and  Li  [1991], 
the  particular  elements  in  the  matrix  should  be  chosen  as  high  as  possible  (to  achieve 
performance  improvement)  without  exciting  any  unmodelled  dynamics  such  as  resonant 
modes  or  to  interfere  with  any  unmodelled  time-delays  (e.g.  actuator  response).  With  this 
latter  point  in  mind,  A  was  set  equal  to  the  diagonal  matrix  with  [.1  .2  .2  1  .75  .75]T  on 
the  main  diagonal.  These  values  are  representative  of  the  possible  rate-of-response  in  the 
various  DOF's. 

A  functional,  6  DOF  sliding  controller  based  on  the  preceding  discussion  was 
implemented  using  MATLAB  using  the  21UUV  body  and  hydrodynamic  coefficients  of 
Appendix  I.  Figure  3.1  depicts  the  desired  and  actual  depth  and  trackline  responses  in 
a  coordinated  5  meter  rise  /  5  meter  shift  in  trackline  occurring  over  a  40  second  period 
of  time  with  the  vehicle  attempting  to  maintain  a  constant  speed  of  5  knots.  A  slight 
(+10  N  more  buoyancy)  mismatch  in  weight/buoyancy  was  assumed,  as  were  slightly  non- 


'The  21UUV  of  figure  1.1  actually  has  excellent  state  measurement  capabilities 
(including  accelerations).   No  state  observers  are  necessary. 
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zero  values  for  xr.  and  zn. 
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Figure  3.1  -  Comparison  of  Actual  vs.  Desired  Vehicle  Response  During  a  Coordinated  Maneuver 
Assuming  Full  6  DOF  Control  Authority  Available.  The  vehicle  follows  the  commanded  trajectories  (dotted 
lines  -  5  m  rise  coupled  with  a  5  m  trackline  change)  extremely  well  as  is  expected  assuming  the  availability 
of  full  6  DOF  control  authority  as  might  be  the  case  for  a  vehicle  designed  to  hover.  The  error  between 
the  actual  and  desired  response  is  due  to  the  assumed  errors  in  the  body  and  hydrodynamic  coefficients. 
Also  this  simulation  assumed  a  positive  10  N  buoyancy. 


39 


Chapter  4 


4  DOF  Implementation  of  the  6  DOF 
Sliding  Controller 

4.1    General  Discussion 

The  6  DOF  control  authority  assumed  to  exist  in  the  simulation  of  figure  3.1  rarely 
exists  in  practical  UUV's  -  except  for  a  very  few  specialized  vehicles  which  are 
specifically  designed  for  demanding  maneuvers  such  as  hovering.  Rather,  the  typical 
UUV  will  have  a  limited  number  of  controllable  DOF's  such  as  the  four  available  to  the 
21UUV  of  figure  1.1  -  sternplanes,  rudder,  ailerons  and  propulsor  (thrust).  This  chapter 
will  present  the  development  of  a  working  4  DOF  implementation  of  the  6  DOF  sliding 
controller  for  the  2 1  UUV  which  will  be  shown  to  be  effective  for  a  broad  range  of  useful 
commanded  maneuvers.  This  4  DOF  implementation  relies  on  the  well-known  non- 
minimum  phase  relationship  between  the  pitch/depth  and  yaw/trackline  DOF's  and  is 
similar  in  concept  to  the  inner/outer  loop  pitch(yaw)/depth(heading)  controllers  currently 
used  in  scalar  sliding  or  PID  controllers  for  UUV's  that  are  assumed  to  be  decoupled  in 
the  pitch-yaw  planes.     An  argument  -  not  proof  -  will  be  presented  as  to  why  this 
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controller  implementation  works;  an  argument  supported  by  a  number  of  computer 
simulations.  This  argument  also  suggests  directions  in  which  further  study  might  be 
pursued  to  improve  this  4  DOF  controller  implementation  and  how  to  develop  other 
controllers  based  on  UUV's  with  different  combinations  of  available  control 
surfaces/thrusters  than  the  21UUV  of  figure  1.1. 

4.2    6  DOF  Commanded  to  4  DOF  Available  Control 

The  fundamental  problem  is  the  conversion  the  commanded  t  vector  -  the  body- 
referenced  force/moment  vector  converted  from  the  earth-referenced  xn  output  of  the  6 
DOF  sliding  controller  (3.28)  -  to  proper  control  signals  for  the  UUV  thrusters/control 
surfaces. 

For  example,  the  21  UUV  of  figure  1.1  has  four  controllable  DOF  -  two  sternplanes 
(8J  -  which  directly  influence  the  pitch/depth  DOF's;  two  rudders  (8r)  -  which  directly 
influence  the  yaw/trackline  DOF's;  a  thruster  (propulsor)  (T)  -  which  directly  controls  the 
forward  speed  and  thus  the  longitudinal  motion;  and  ailerons  (SJ  -  which  directly  control 
the  roll  angle.  The  aileron's  action  is  accomplished  by  appropriate  opposing  settings  on 
the  two  sternplanes  and/or  rudders.  There  is  also  some  coupling  between  the  various 
controls  -  e.g.  the  rudders  affect  roll  to  a  degree. 

Note  that  the  sternplanes  and  rudders  must  each  control  two  degrees  of  freedom 
in  the  21  UUV  configuration.  In  scalar  sliding  control  design  (e.g.  Fossen  [1994],  Hills 
and  Yoerger  [1994]),  this  is  typically  managed  by  using  inner  pitch/outer  depth  loops 
(similarly,  inner  yaw/outer  trackline  loops)  in  which  the  desired  pitch  angle  at  each  time 
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step  is  generated  by  the  depth  trajectory  error  at  that  time  step.  To  maintain  the 
matrix/vector  format  of  6  DOF  sliding  controller,  the  vector  sliding  control  design 
considered  in  this  study  employs  a  least-squares  methodology  to  overcome  this  problem 
as  detailed  in  the  following  sub-sections. 

4.2.1    Unweighted  Least  Squares 

The  control  inputs  for  the  21UUV  can  be  grouped  as  a  vector  ubody  which  is  related 
to  x  by: 

x  -Buhody  =B[T6s6r6f  (4-1) 

As  stated,  the  problem  is  that  the  B  matrix  relating  the  commanded  force/moment 
vector  to  the  available  force  moment  vector  is  6x4;  that  is,  (4.1)  is  an  underdetermined 
system  of  equations  for  which,  in  general,  no  exact  solution  exists.  However,  the  error 
e  between  t  and  Bubody  where: 

•  -  *  -  B«M,  <4-2) 

can  be  minimized  by  minimizing  the  length  of  I  I  e  |  |2  =  (x  -  Bubody)T(x  -  Bubody)\  the 
least  squares  solution.  From  standard  matrix  theory  (e.g.  Strang  [1986]),  the  unweighted 
least  squares  solution  to  (4.1)  is: 


"Mr  =  (BTB)lBT*  (4-3) 
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4.2.2    Weighted  Least  Squares 

Unfortunately,  straightforward  application  of  (4.3)  leads  to  unstable  control  action 
for  any  21UUV  typical  maneuver.  This  can  be  seen  from  the  coefficients  that  govern  the 
pitch/depth  and  yaw/heading.  For  instance,  consider  the  hydrodynamic  coefficients 
relating  rudder  angle  to  yaw  and  heading  -  N&r  and  Yhr.  From  Appendix  I,  the 
coefficients  are  opposite  in  sign,  meaning  that  for  a  course  change  in  which  both  a  yaw 
angle  and  heading  trajectory  in  the  same  directions  would  be  commanded,  (4.3)  would 
be  trying  to  the  impossible  feat  of  moving  the  rudder  in  opposite  directions  at  the  same 
time!  The  same  analysis  holds  for  the  pitch/depth  coupled  maneuvers  (taking  into 
account  that  +z  is  defined  in  the  down  direction). 

This  is  a  well-known  problem  of  not  only  torpedo-shape  underwater  vehicles  such 
as  the  21UUV,  but  also  of  aircraft  (see  Slotine  and  Li  [1991],  for  example).  The  solution 
to  maneuvering  vehicles  that  possess  such  characteristics  is  to  first  operate  the  control 
surface  to  get  the  desired  angle-of-attack,  then  to  reverse  the  direction  of  the  control 
surface  so  that  the  translational  portion  of  the  maneuver  (depth  or  trackline)  is  satisfied. 
Such  behavior  is  termed  non-minimum  phase,  and  an  appropriate  way  must  be  found  to 
incorporate  such  behavior  into  the  mathematics  of  (4.3). 

One  way  to  accomplish  this  would  be  to  command  proper  desired  trajectories  to 
follow  so  that  the  correct  non-minimum  phase  response  would  be  enacted  by  the  vehicle. 
Unfortunately,  this  is  an  open-loop  solution  and  is  of  doubtful  utility  when  parameter  and 
modelling  uncertainties  are  introduced,  not  to  mention  any  disturbances  the  vehicle  would 
experience  in  shallow- water. 
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A  better  solution  is  to  modify  (4.3)  so  that  it  captures  the  non-minimum  phase 
characteristics  of  the  21UUV  -  that  is,  the  vehicle  angle  orientation  is  achieved  first 
(faster  time  constant),  then  the  slower  lateral  or  vertical  translation  takes  place.  Looking 
at  the  A  matrix  of  the  6  DOF  sliding  controller  (3.18),  we  see  this  has  been  partially 
accomplished  by  the  performance  weightings  on  the  DOF's;  the  .75  value  for  pitch  and 
yaw  allows  faster  vehicle  orientation  response  that  the  .2  value  for  depth  and  heading. 
Then,  weighting  the  error  e  by  a  matrix  W  such  that: 


Xx    0     0     0      0      0 
0     XY    0     0      0      0 


We  = 


0  0  xz  0  0  0 
0  0  0  XK  0  0 
0     0     0     0    xM    0 


0     0     0     0      0     A 


jV 


(4.4) 


where  the  weights  X,  and  the  desired  trajectories  are  properly  chosen  forces  the  vehicle 
into  the  correct  non-minimum  phase  behavior  to  achieve  commanded  trajectories  as  is 
argued  in  the  following  sub-section.1  Defining  C=WTW,  then  (4.3)  becomes  in  weighted 
least  squares  (e.g.  Strang  [1986]): 


<dy  =  &  TCBrlB  Tc* 


(4.5) 


After  some  trial  and  error  as  documented  in  the  following  simulations  of  the 


'Considering  the  significant  coupling  between  pitch  and  depth  DOF's  for  example  it 
might  be  prudent  to  actually  consider  a  non-diagonal  form  for  W  -  this  was  not  examined 
in  this  study. 
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following  section,  a  "good"  W  was  determined  to  be: 


W  = 


10   0   0 

0 

0 

0    10   0 

0 

0 

0   0    10 

0 

0 

0   0   0    1 

0 

0 

0   0   0   0 

.06 

0 

0   0   0   0 

0 

.06 

(4.6) 


4.2.3   Justification  for  the  Weighted  Least  Squares  Method 

For  simplicity  and  clarity,  only  a  21UUV  dive  is  considered;  by  vehicle  symmetry 
similar  arguments  apply  to  vehicle  climbs  and  trackline  changes. 

A  key  assumption  in  this  methodology  is  that  the  desired  vehicle  pitch  angle, 
angular  rate  and  acceleration  are  always  chosen  to  be  zero  -  only  the  z-axis  has  non-zero 
desired  r\d,  r\d  and  r\d  during  the  dive  (along  with  x-axis  non-zero  r\d  and  r\d).  Then,  from 
(3.6),  initial  non-zero  reference  trajectories  r\r  and  r\r  in  the  x-  and  z-axes  are  generated, 
which  in  turn  from  the  sliding  control  law  (3.14)  generates  earth-reference  commands  xn 
in  these  two  DOF's.2 

The  non-zero  reference  trajectories  also  generate  an  initial  non-zero  xn  in  the  pitch 
DOF  due  to  coupling  coefficients  between  the  pitch  and  x/z  DOF's  that  exist  in  the 
matrices  of  (3.14).  This  commanded  moment  can  be  viewed  as  a  feed-forward  term  that 


2Note  that  the  distinction  clear  between  the  body-  and  earth-referenced  frames  is  not 
rigorously  maintained  in  this  particular  analysis.  Considering  the  J  matrix  would  only 
obscure  the  relevant  ideas;  anyway  J  is  very  close  to  being  the  identity  matrix  throughout 
the  analysis. 
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is  balancing/negating  the  moment  that  is  generated  when  diving.  A  study  of  these 
coupling  coefficients  reveals  that  this  commanded  moment  requires  the  stemplanes  to 
move  in  the  opposite  direction  that  the  commanded  force  for  the  dive  requires.3 

Thus  to  satisfy  this  non-minimum  phase  characteristic  between  pitch  and  dive,  the 
pitch  demand  must  be  satisfied  first  as  previously  discussed.  This  is  accomplished  by 
underweighting  pitch  relative  to  depth  in  the  weighting  matrix  W.  To  understand  how 
this  works,  consider  only  the  depth  and  pitch  axes  for  a  moment  which  results  in  the 
unweighted  least  squares  solution  of  (4.3)  to  look  like: 


t_  «       i 


hs  =  (forw.  vel.y2  [-£*  +  -^j£*]  (4.7) 


Z6.  M6. 


and  the  weighted  least  squares  solution  of  (4.5)  to  look  like: 


6S  =  (forw.  vel.y2  [—  + ^shz^L ]  (4  8) 

Z6         (pitchweight)  xM6 


See  Appendix  I  for  the  values  of  the  sternplane  hydrodynamic  coefficients.  Comparing 
(4.7)  and  (4.8),  it  is  apparent  that  increasing  the  underweighting  the  pitch  weight  forces 
the  stemplanes  to  respond  more  quickly  to  the  pitch  command  resulting  from  the  control 
law  of  (3.14)  and  delays  the  implementation  of  the  dive  command.  When  optimally 
chosen,  the  pitch  weighting  results  in  the  vehicle  achieving  the  optimal  pitch  angle  as  it 


3This  assertion,  though  true  for  the  particular  magnitudes  and  signs  of  the  relevant 
hydrodynamic  coefficients  listed  in  Appendix  I,  needs  to  be  more  fully  analyzed  for  the 
all  the  possible  variations  in  these  magnitudes  and  signs  to  ensure  that  the  weighting 
value  in  the  W  matrix  remains  optimal  and,  more  importantly,  keeps  the  controller  stable. 
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executes  the  dive. 

4.3    Simulations 

Extensive  numerical  simulations  are  presented  in  this  section  to  illustrate  21UUV 
response  for  a  variety  of  commanded  maneuvers  and  to  further  clarify  the  implications 
of  the  weighted  least  squares  methodology  utilized  to  obtain  6  DOF  satisfactory  vehicle 
control  from   4  DOF  control  authority. 

4.3.1    Determination  of  Optimal  X/s 

The  control  hydrodynamic  coefficients  used  for  the  B  matrix  of  (4.1)  are  listed  in 
Appendix  I.  The  angle  squared  terms  could  not  be  directly  included  into  this  matrix  else 
(4.5)  could  not  be  solved  via  normal  matrix  means.  Fortunately,  these  terms  are  rather 
small  for  typical  maneuvers  and  speeds  and  can  safely  be  ignored.4 

As  is  demonstrated  from  the  figures  there  is  an  optimal  weighting  for  the  best 
depth-pitch  response  -  A.ss.06.  As  the  next  two  sub-sections  show,  it  appears  this  value 
is  good  over  a  range  of  speeds  and  dive  rates. 


"For  the  simulations  that  follow,  the  angle  squared  terms  are  included  in  the  21UUV's 
"real"  dynamics  for  simulation  purposes.  As  is  evident  from  the  simulation  plots,  vehicle 
response  does  not  appear  adversely  affected. 
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Figure  4.1  -  Comparison  of  Sternplane  Response  in  a  Commanded  Dive  for  Pitch  Weights  of  \=.  06  and 
X=.l.  Overweighting  the  pitch  error  weight  relative  to  the  depth  error  weight  (A.=.l/1  vice  .06/1)  overly 
restricts  the  range  of  allowed  initial  sternplane  motion  and  results  in  the  sternplanes  being  applied  for  too 
long  at  excessive  angles  during  the  remainder  of  the  commanded  maneuver  with  deleterious  effects  on 
vehicle  dive  response  as  shown  in  successive  figures.  Note  the  non-minimum  phase  action  of  the 
sternplanes  -  initially  moving  in  one  direction  to  get  the  requisite  pitch  angle  for  the  commanded  dive,  then 
moving  in  the  opposite  direction  to  allow  the  vehicle  to  change  depth. 
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Figure  4.2  -  Comparison  of  Depth  and  Depth  Rate  Responses  in  a  Commanded  Dive  for  Pitch  Weights 
of\=.06  and  k=.l.  Excessively  high  pitch  weighting  (X=.l  vice  .06)  results  in  the  vehicle  hunting  about 
the  commanded  depth  and  depth  rate  trajectories  (indicated  by  dotted  lines).  The  vehicle's  sternplanes  do 
not  initially  achieve  sufficient  angles  to  get  vehicle  pitch  to  its  optimal  angle.  The  sliding  controller  -  which 
is  governed  by  the  equations  of  motion  and  the  commanded  trajectories  -  then  acts,  in  a  simplified  sense, 
as  a  lightly  damped  system  as  the  sternplane  angle  and  direction  is  dominated  first  by  moment  control,  then 
depth  control,  etc.  as  it  attempts  to  follow  the  depth  change  trajectory. 
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Figure  4.3  -  Comparison  of  Pitch  and  Pitch  Rate  Responses  in  a  Commanded  Dive  for  Pitch  Weights 
ofk=.06  and  X=.  1.  Limiting  the  allowed  initial  stemplane  motion  (X=A  vice  .06)  results  in  the  overall 
pitch  response  to  be  excessive.    See  figure  4.2. 
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Figure  4.4  -  Comparison  of  Forward  Speed  and  Thrust  Responses  in  a  Commanded  Dive  for  Pitch 
Weights  of\=.06  and  X=.l.  Similar  responses  for  both  pitch  error  weightings.  Note  that  the  initial 
overestimation  of  needed  thrust  is  endemic  to  all  the  simulations  of  this  study  as  a  result  of  the  particular 
assumed  errors  between  the  "true"  and  estimated  values  for  the  hydrodynamic  coefficients. 
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Figure  4.5  -  Comparison  of  Sternplane  Response  in  a  Commanded  Dive  for  Pitch  Weights  ofX=.06  and 
A.=  04.  Underweighting  the  pitch  error  weight  relative  to  the  depth  error  weight  (X=. 04/1  vice  .06/1)  causes 
the  initial  sternplane  motion  to  be  overly  excessive  and  results  in  the  requisite  pitch  angle  for  optimal  dive 
performance  not  being  achieved  as  seen  in  the  following  figures. 
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Figure  4.6  -  Comparison  of  Depth  and  Depth  Rate  Responses  in  a  Commanded  Dive  for  Pitch  Weights 
of\=.06  and  A.=. 04.  As  evidenced  in  the  next  figure,  the  underweighting  of  the  pitch  weighting  (k=.04 
vice  .06)  results  in  the  vehicle  not  achieving  the  optimal  pitch  angle  to  best  effect  the  commanded  depth 
and  depth  rate  trajectories  (indicated  by  dotted  lines). 
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Figure  4.7  -  Comparison  of  Pitch  and  Pitch  Rate  Responses  in  a  Commanded  Dive  for  Pitch  Weights 
of\=.06  and  \=04.  Underweighing  the  pitch  error  weighing  (X=.04  vice  .06)  actually  results  in  the 
sternplanes  cycling  so  quickly  that  the  optimal  pitch  angle  for  the  commanded  dive  is  never  quite  achieved 
causing  the  depth  response  to  be  not  as  good  for  the  \=.06  weighting.  This,  in  analogy  with  linear  systems, 
is  exhibiting  characteristics  of  being  slightly  overdamped.  So  little  moment  is  generated  by  the  sliding 
controller  after  the  initial  sternplane  transient  that  the  optimal  pitch  angle  is  not  obtained. 
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Figure  4.8  -  Comparison  of  Forward  Speed  and  Thrust  Responses  in  a  Commanded  Dive  for  Pitch 
Weights  ofk=06  and  ^=04.    Similar  responses  for  both  pitch  error  weightings.   See  figure  4.4. 
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4.3.2    Effect  of  Vehicle  Speed  on  Optimal  A,/s 

The  shape  of  vehicle  depth  response  appears  to  be  little  influenced  by  the  speed 
of  the  commanded  trajectory  for  a  given  X  weighting. 
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Figure  4.9  -  Comparison  of  Sternplane  Response  in  a  Commanded  Dive  at  5  and  8  Knots  Nominal  Speed 
for  a  Pitch  Weighting  ofX=.06.  The  increased  speed  increases  the  authority  of  all  control  surface  and 
consequently  less  sternplane  response  is  required  at  8  vs.  5  knots  nominal  speed. 
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Figure  4.10  -  Comparison  of  Depth  and  Depth  Rate  Responses  in  a  Commanded  Dive  at  5  and  8  Knots 
Nominal  Speed  for  a  Pitch  Weighting  ofX=.06.  Note  the  extremely  similar  response  for  the  two  speeds, 
an  indication  that  the  pitch  weighting  value  is  relatively  independent  of  vehicle  speed.  Rather,  the  X  value 
is  better  viewed  as  reflecting  the  dynamic  coupling  between  the  pitch  and  depth  DOF's. 
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Figure  4.11  -  Comparison  of  Pitch  and  Pitch  Rate  Responses  in  a  Commanded  Dive  at  5  and  8  Knots 
Nominal  Speed  for  a  Pitch  Weighting  of\=.06.  Similarly  shaped  responses;  naturally  at  8  knots  less  pitch 
angle  is  needed  to  generate  the  commanded  depth  change. 
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Figure  4.12  -  Comparison  of  Forward  Speed  and  Thrust  Responses  in  a  Commanded  Dive  at  5  and  8 
Knots  Nominal  Speed  for  a  Pitch  Weighting  of\=.06.  Similarly  shaped  responses,  though  the  8  knot 
response  approaches  the  commanded  speed  faster  due  to  the  increased  forward  drag  (from  Xu\u\ 
hydrodynamic  coefficient). 
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4.3.3    Effect  of  Trajectory  Severity  on  Optimal  A./s 

The  shape  of  vehicle  depth  response  appears  to  be  little  influenced  by  the  severity 
of  the  commanded  trajectory  for  a  given  X  weighting  -  further  evidence  that  the  optimal 
A.  is  a  direct  consequence  of  the  underlying  dynamics  relating  pitch  and  depth. 


61 


Sternplane  Response  -  2.5  m  Dive 


10  20 

Time  (Sec) 


30 


en 

CD 
T), 

_CD 
CD 

c 

< 

CD 

c 

_CC 
CL 

c 

CD 
CD 


20 

Sternplane  Resp 

>onse 

-  5  m  Dive 

10 

• 

0 

-10 

on 

• 

0 


10  20 

Time  (Sec) 


30 


Figure  4.13  -  Comparison  of  Sternplane  Response  in  Commanded  Dives  of  2.5  and  5  Meters  at  5  Knots 
Nominal  Speed  for  a  Pitch  Weighting  ofX=.06.  Similarly  shaped  responses;  naturally,  approximately  twice 
the  sternplane  angle  is  required  to  effect  twice  the  depth  change  in  equal  amounts  of  time. 
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Figure  4.14  -  Comparison  of  Depth  and  Depth  Rate  Responses  in  Commanded  Dives  of  2.5  and  5  Meters 
at  5  Knots  Nominal  Speed  for  a  Pitch  Weighting  of\=.06.  Note  the  extremely  similarly  shaped  responses 
for  the  two  commanded  depth  changes,  another  indication  that  the  pitch  weighting  value  purely  reflects  the 
dynamic  coupling  between  the  pitch  and  depth  DOF's. 
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Figure  4.15  -  Comparison  of  Pitch  and  Pitch  Rate  Responses  in  Commanded  Dives  of  2.5  and  5  Meters 
at  5  Knots  Nominal  Speed  for  a  Pitch  Weighting  ofX=.06.     Similarly  shaped  responses  -  see  figure  4.14. 


64 


Forward  Speed  -  2.5  m  Dive 


Forward  Speed  -  5  m  Dive 


0 


220 


10  20 

Time  (Sec) 

Propulsor  Thrust  -  2.5  m  Dive 


10  20 

Time  (Sec) 


30 


0 


220 


10  20 

Time  (Sec) 

Propulsor  Thrust  -  5  m  Dive 


10  20 

Time  (Sec) 


30 


Figure  4.16  -  Comparison  of  Forward  Speed  and  Thrust  Responses  in  Commanded  Dives  of  2.5  and  5 
Meters  at  5  Knots  Nominal  Speed  for  a  Pitch  Weighting  ofk=.06.  Similarly  shaped  responses,  as  expected 
from  the  previous  results. 
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4.3.4    Vehicle  Roll  Capability 

As  evidenced  in  the  following  plots,  the  ailerons  do  not  provide  enough  control 
authority  to  control  roll  during  a  commanded  roll  maneuver.  Fortunately,  this  is  not  a 
particularly  desirable  trajectory  -  it  is  much  more  important  that  the  vehicle  not  roll 
during  turns  and/or  depth  changes.  This  lack  of  control  authority  made  the  weighting  of 
this  the  roll  DOF  rather  moot  -  XK  was  set  at  1. 
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Figure  4.17  -  Roll  and  Aileron  Responses  for  a  Commanded  Counter-Clockwise  Roll  of  10  Degrees.  The 
vehicle  has  great  difficulty  executing  this  commanded  maneuver  due  primarily  to  the  low  control  authority 
in  this  degree  of  freedom  (due  to  the  small  value  of  K)  -  note  the  saturated  control  surface  -  but  also  to  the 
restoring  force  incurred  by  the  assumed  zG-zB  separation  of  .005  m  and  the  simulated  10  N  positive 
buoyancy.  Fortunately,  it  is  difficult  to  conceive  when  a  vehicle  like  the  21UUV  would  require  such  a 
maneuver;  it  is  much  more  important  that  the  vehicle  avoid  rolling  in  the  presence  of  disturbances  or  during 
more  typical  maneuvers  such  as  trackline  changes.  Also  note  the  non-minimum  phase  response  of  the 
ailerons  in  the  initial  stages  of  the  commanded  roll. 
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Figure  4.18  -  Depth  and  Pitch  Angle  Responses  for  a  Commanded  Counter-Clockwise  Roll  of  10  Degrees. 
Mostly  a  result  of  the  10  N  positive  buoyancy;  but  there  is  slight  coupling  from  the  roll  DOF. 
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Figure  4.19  -  Trackline  and  Yaw  Angle  Responses  for  a  Commanded  Counter-Clockwise  Roll  of  10 
Degrees.   Note  the  slight  coupling  from  the  roll  DOF. 
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Figure  4.20  -  Stemplane  and  Rudder  Responses  for  a  Commanded  Counter-Clockwise  Roll  of  10 
Degrees.  The  stemplane  response  is  mainly  a  result  of  the  positive  buoyancy,  but  both  control  surfaces 
contribute  a  bit  to  the  control  of  the  roll  angle. 
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4.3.5   Vehicle  Coordinated  Maneuvering  Response 

To  test  the  vector  sliding  controller  out  in  the  4  DOF  available  control  mode, 
simulations  were  performed  with  coordinated  trajectories  (e.g.  dive  and  trackline  change 
simaltaneously).  As  is  seen  in  the  plots,  response  is  excellent  indicating  that  the 
controller  is  easily  able  to  handle  complicated  and  coupled  maneuvers. 


71 


Commanded  Dive  and  Trackline  Change 


30 
Time  (Sec) 

Commanded  Dive  and  Trackline  Change 


30 
Time  (Sec) 


60 


60 


Figure  4.21  -  Depth  and  Depth  Rate  for  a  Coordinated  Dive  and  Trackline  Maneuver  with  a  10  N 
Positive  Buoyancy.  The  4  DOF  implementation  of  the  6  DOF  controller  provides  excellent  control  in  this 
coupled  maneuver. 
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Figure  4.22  -  Trackline  and  Heading  Rate  for  a  Coordinated  Dive  and  Trackline  Maneuver  with  a  10 
N  Positive  Buoyancy.  The  4  DOF  implementation  of  the  6  DOF  controller  provides  excellent  control  in  this 
coupled  manuever. 
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Figure  4.23  -  Sternplane  and  Rudder  Responses  for  a  Coordinated  Dive  and  Trackline  Maneuver  with 
a  ION  Positive  Buoyancy.  As  expected  from  the  symmetry  about  the  y-  and  z-axes,  control  surface  actions 
are  similar  (though  in  different  directions  due  to  the  chosen  coordinated  maneuver).  Note  the  non-minimum 
phase  actions  of  the  control  surfaces  -  first  get  the  requisite  pitch  and  yaw  angles,  respectively,  then  allow 
for  the  depth  and  trackline  changes. 
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Figure  4.24-  Pitch  and  Pitch  Rate  for  a  Coordinated  Dive  and  Trackline  Maneuver  with  a  10  N  Positive 
Buoyancy.   Corresponds  to  depth  and  depth  rate  responses. 
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Figure  4.25-  Yaw  and  Yaw  Rate  for  a  Coordinated  Dive  and  Trackline  Maneuver  with  a  10  N  Positive 
Buoyancy.   Corresponds  to  trackline  and  heading  rate  responses. 
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Figure  4.26-  Forward  Speed  and  Thrust  for  a  Coordinated  Dive  and  Trackline  Maneuver  with  a  10  N 
Positive  Buoyancy.    Response  as  expected. 
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Figure  4.27-  Roll  and  Aileron  Angles  for  a  Coordinated  Dive  and  Trackline  Maneuver  with  a  10  N 
Positive  Buoyancy.  As  alluded  to  in  figure  4.17,  it  is  important  that  the  4  DOF  implementation  of  the  6 
DOF  sliding  controller  be  able  to  control  roll  response  in  normal  commanded  maneuvers  (and  in 
disturbances).  Unfortunately,  the  low  value  of  the  hydrodynamic  coefficient  Kp  causes  this  DOF  to  respond 
like  a  very  underdamped  spring-mass  system,  resulting  in  saturated  aileron  response.  The  saving  grace  is 
the  restoring  force  generated  by  the  Zo-zB  separation  -  thus  the  roll  DOF  can  be  thought  as  "stabilizable" 
if  not  actually  "controllable".  If  this  situation  is  deemed  unacceptable  corrective  action  -  e.g.  larger  ailerons 
-  is  required. 
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Figure  4.28  -  Depth  and  Depth  Rate  for  a  Coordinated  Rise  and  Trackline  Maneuver  with  a  10  N 
Positive  Buoyancy.  The  4  DOF  implementation  of  the  6DOF  controller  provides  excellent  control  in  this 
coupled  manuever.  Note  the  controller  provides  similar  control  for  this  combination  of  vehicle  positional 
changes  as  for  the  previous  commanded  positional  changes  (see  figures  4.21-4.27)  and  for  another  set  of 
positional  changes  depicted  in  figures  5.4-5.10  (ignoring  the  imposed  disturbance).  Thus  the  controller  is 
shown  to  be  equally  effective  no  matter  what  the  combination  of  coordinated  maneuvers  in  the  depth  and 
trackline  planes. 
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Figure  4.29  -  Trackline  and  Heading  Rate  for  a  Coordinated  Rise  and  Trackline  Maneuver  with  a  10  N 
Positive  Buoyancy.  The  4  DOF  implementation  of  the  6  DOF  controller  provides  excellent  control  in  this 
coupled  maneuver. 
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Figure  4.30  -  Sternplane  and  Rudder  Responses  for  a  Coordinated  Rise  and  Trackline  Maneuver  with 
a  10  N  Positive  Buoyancy.  As  expected  from  the  symmetry  about  the  y-  and  z-axes,  control  surface  actions 
are  similar.  Note  the  non-minimum  phase  actions  of  the  control  surfaces  -  first  get  the  requisite  pitch  and 
yaw  angles,  respectively,  then  allow  for  the  depth  and  trackline  changes. 
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Figure  4.31  -  Pitch  and  Pitch  Rate  for  a  Coordinated  Rise  and  Trackline  Maneuver  with  a  10  N  Positive 
Buoyancy.   Corresponds  to  depth  and  depth  rate  responses. 
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Figure  4.32-  Yaw  and  Yaw  Rate  for  a  Coordinated  Rise  and  Trackline  Maneuver  with  a  10  N  Positive 
Buoyancy.   Corresponds  to  trackline  and  heading  rate  responses. 
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Figure  4.33-  Forward  Speed  and  Thrust  for  a  Coordinated  Rise  and  Trackline  Maneuver  with  a  10  N 
Positive  Buoyancy.    Response  as  expected. 
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Figure  4.34-  Roll  and  Aileron  Angles  for  a  Coordinated  Rise  and  Trackline  Maneuver  with  a  10  N 
Positive  Buoyancy.    See  figure  4.17. 
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Chapter  5 


Related  Topics  to  the  6  DOF  Sliding 
Controller 


In  this  chapter,  two  specific  areas  of  UUV  control  that  are  facilitated  by  the 
framework  of  the  6  DOF  sliding  controller  developed  in  Chapter  3  -  variable  buoyancy 
control  and  wave  disturbance  rejection  -  are  briefly  discussed  accompanied  by  appropriate 
simulations.     Directions  further  research  in  these  areas  might  take  is  also  discussed.. 

5.1    Variable  Buoyancy 

As  the  6  DOF  sliding  controller  operates,  a  vector  consisting  of  the  earth- 
referenced  control  forces/moments  needed  to  achieve  trajectory  following  is  generated  (xn 
-  see  (3.15)).  This  signal  is  precisely  what  is  needed  for  the  input  to  a  variable  buoyancy 
controller  which  is  trying  to  maintain  the  UUV  in  a  neutrally  buoyant  condition! 

Consider,  for  instance,  the  scenario  depicted  in  figures  5.1-5.3  in  which  the 
21  UUV  of  figure  1.1  with  the  4  DOF  version  of  the  6  DOF  sliding  controller  is 
commanded  to  travel  a  straight  line  at  5  knots.  The  vehicle  is  simulated  to  have  20  N 
positive  buoyancy  for  the  first  portion  of  the  "maneuver"  which  is  then  decreased  to  10 
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N  positive  buoyancy  (e.g.  the  vehicle  encounters  a  region  of  less  dense  water).  As  the 
vehicle  orients  itself  to  the  weight/buoyancy  mismatch,  the  Z  portion  of  Tn  approaches 
the  negative  value  of  this  mismatch.  This  signal,  perhaps  passed  though  a  low-pass  filter 
to  eliminate  wave  and  other  disturbances,  is  easily  processed  to  control  the  requisite 
changing  of  the  weight  of  the  vehicle  to  restore  neutral  buoyancy. 

Note  how  the  6  DOF  sliding  controller  directly  provides  the  signals  needed  for  the 
task  of  buoyancy  control.  There  is  no  need  to  correct  for  vehicle  orientation  with  respect 
to  the  earth  (it  is  already  done),  nor  is  their  a  need  to  resolve  the  vehicle  control  actions 
into  the  various  DOF's  as  is  necessary  if  trying  to  compute  the  weight/buoyancy 
mismatch  from  a  measurement  of  the  sternplane  angle  alone. 

As  mentioned,  further  work  is  needed  get  a  viable  buoyancy  control  system  based 
on  the  6  DOF  sliding  controller,  mostly  in  the  area  of  signal  processing  -  e.g.  filtering 
disturbances  out  oft-,  getting  a  good  pitch  commanded  moment  signal  free  of  the  4  DOF 
feedthrough  from  the  depth  DOF  etc. 
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Figure  5.1  -  6  DOF  Sliding  Controller  Generated  Earth-Referenced  Z  Force  and  M  Moment  During  a 
Step  Change  in  Vehicle  Buoyancy.  The  vehicle  is  travelling  at  5  knots.  Vehicle  buoyancy  initially  assumed 
to  be  a  positive  20  N  and  changed  to  (+)  10  N  at  30  seconds  (e.g.  vehicle  entered  region  of  warmer  water); 
xG  assumed  .01  m  forward  of  xB  during  the  entire  maneuver.  These  controller  outputs  are  not  colored  by 
vehicle  orientation  -  though  for  this  particular  scenario  little  error  would  be  introduced  by  considering  body- 
referenced  forces  and  moments  -  and  can  be  processed  to  provide  control  signals  for  a  variable  buoyancy 
system.  The  commanded  moment  is  much  larger  than  one  would  expect  for  the  actual  derivations  from 
perfect  trim  -  the  depth  buoyancy  mismatch  is  feeding  its  way  through  the  4  DOF  controller  to  this  DOF. 
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Sternplane  Response  at  5  knots  Nominal  Speed 
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Figure  5.2  -  Sternplane  Response  During  a  Step  Change  in  Vehicle  Buoyancy.  Actually,  the  sternplane 
angle  can  be  processed  to  provide  control  signals  for  a  variable  buoyancy  system.  However,  vehicle 
orientation  would  have  to  be  taken  into  account  (though  not  a  concern  for  this  particular  scenario)  and  the 
sternplane  angle  would  somehow  have  to  be  split  into  a  moment  and  force  component.  Why  not  just  use 
the  earth-referenced  forces  and  moments  already  generated  by  the  6  DOF  sliding  controller? 
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Figure  5.3  -  Excursions  from  Nominal  Depth  and  Pitch  Angle  During  a  Step  Change  in  Vehicle 
Buoyancy.  As  expected  the  4  DOF  implementation  of  the  6  DOF  sliding  controller  commanded  control 
vector  works  well  for  this  benign  maneuver. 
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5.1.2    Disturbance  Response 

A  large  motivating  factor  in  the  design  of  the  6  DOF  sliding  controller  is  to  permit 
satisfactory  vehicle  operation  in  the  dynamically-challenging  regime  of  shallow  water. 
As  discussed,  the  direct  accounting  of  the  non-linearities  and  coupling  inherent  in  the  6 
DOF  equations  of  motion  by  the  controller  that  was  designed  in  Chapter  3  allows  the 
vehicle  to  withstand  larger  and  more  dynamically  complicated  disturbances  than  for 
simpler  controller  designs  which  largely  ignore  the  coupling  between  the  DOF's. 

This  is  apparent  in  the  simulation  results  depicted  in  figures  5.4-5.10  in  which  a 
coordinated  trackline  and  depth  change  is  performed  in  the  presence  of  significant  wave 
disturbances  (assumed  pitch/depth  disturbance  of  0. 1  meters  amplitude  coupled  with  a 
yaw/heading  disturbance  of  .05  meters  amplitude  at  .2  Hz).  The  vehicle  remains  stable 
as  it  performs  the  maneuver  though  it  does  oscillate  about  its  nominal  orientation. 

It  is  possible  to  reduce  this  oscillation  by  means  of  adaptive  sliding  control 
techniques  (see  Slotine  and  Li  [1991]  for  instance).  As  mentioned  in  chapter  2,  the 
force/moment  vector  x  can  be  viewed  as  consisting  of  a  propulsion/control  part  and  an 
environmental  part.  By  assigning  the  proper  structure  to  the  environmental  part  -  e.g. 
sinusoid  at  a  known  frequency  but  unknown  amplitude  -  one  can  estimate  the  effect  the 
wave  field  has  on  each  DOF  via  an  adaptive  sliding  controller  which  is  fundamentally 
similar  to  sliding  controller  design.  This  is  the  topic  of  the  sister  study  to  this  thesis  - 
Willy  [1994].  We  envision  his  single  DOF  adaptive  sliding  controllers  being  run  in 
parallel  with  the  6  DOF  vehicle  controller  of  this  paper  and  providing  the  estimates  of  the 
disturbances    to    the    vehicle    controller.      This    should    significantly    improve   UUV 

91 


performance  in  waves  and  warrants  further  analysis. 
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Figure  5.4  -  Depth  and  Depth  Rate  for  a  Coordinated  Dive  and  Trackline  Maneuver  with  a  10  N  Positive 
Buoyancy  in  the  Presence  of  Simulated  Wave  Disturbances.  The  4  DOF  implementation  of  the  6  DOF 
controller  provides  excellent  control  in  this  coupled  maneuver  despite  the  significant  imposed  disturbance. 
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Figure  5.5  -  Trackline  and  Heading  Rate  for  a  Coordinated  Dive  and  Trackline  Maneuver  with  a  10  N 
Positive  Buoyancy  in  the  Presence  of  Simulated  Wave  Disturbances.  The  4  DOF  implementation  of  the  6 
DOF  controller  provides  excellent  control  in  this  coupled  maneuver  despite  the  significant  imposed 
disturbance. 
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Figure  5.6  -  Sternplane  and  Rudder  Responses  for  a  Coordinated  Dive  and  Trackline  Maneuver  with  a 
10  N  Positive  Buoyancy  in  the  Presence  of  Simulated  Wave  Disturbances.  The  imposed  disturbance  causes 
intermittent  saturation  of  the  sternplanes  -  the  y-axis  is  not  subjected  to  as  high  a  disturbance  magnitude, 
thus  the  rudders  do  not  saturate  -  yet  the  vehicle  controller  is  still  able  to  maintain  excellent  trajectory 
following  for  this  coupled  maneuver  as  shown  in  figures  5.4  and  5.5. 
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Figure  5.7-  Pitch  and  Pitch  Rate  for  a  Coordinated  Dive  and  Trackline  Maneuver  with  a  10  N  Positive 
Buoyancy  in  the  Presence  of  Simulated  Wave  Disturbances.  Again,  despite  the  significant  effect  the 
disturbance  has  on  the  dynamics  as  shown  here,  the  vehicle  controller  remains  stable. 
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Figure  5.8-  Yaw  and  Yaw  Rate  for  a  Coordinated  Dive  and  Trackline  Maneuver  with  a  10  N  Positive 
Buoyancy  in  the  Presence  of  Simulated  Wave  Disturbances.    See  figure  5.7. 
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Figure  5.9-  Forward  Speed  and  Thrust  for  a  Coordinated  Dive  and  Trackline  Maneuver  with  a  10  N 
Positive  Buoyancy  in  the  Presence  of  Simulated  Wave  Disturbances.  The  thrust  response  may  not  be 
realistically  achievable.   A  better  model  of  the  propulsor  is  needed. 
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Figure  5.10-  Roll  and  Aileron  Angles  for  a  Coordinated  Dive  and  Trackline  Maneuver  with  a  10  N 
Positive  Buoyancy  in  the  Presence  of  Simulated  Wave  Disturbances.  Despite  the  near-constant  aileron 
saturation,  the  roll  response  stays  within  reasonable  bounds.  Of  course,  this  is  primarily  due  to  the 
sinusoidal  nature  of  the  disturbance  and  resultant  sinusoidal  yaw  and  pitch  motion  rather  than  by  any  control 
authority  exerted  by  the  ailerons  (refer  to  figures  4.17  and  4.27).  Matters  could  be  worse  for  a  constant 
disturbance  affecting  the  roll  DOF  but  it  is  difficult  to  imagine  a  natural  phenomenon  providing  such  a 
disturbance.  For  instance,  a  cross-current  -  though  constant  -  can  not  really  "catch"  the  control  surfaces 
enough  to  cause  the  vehicle  to  start  rolling  as  the  force  imposed  on  the  upper  control  surfaces  is 
counterbalanced  by  the  force  imposed  on  the  lower  ones. 
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Chapter  6 


Conclusion 

A  full  accounting  of  the  conclusions  drawn  from  this  research  and  suggested 
directions  for  continued  investigation  can  be  found  in  the  preceding  chapters.  Section  6. 1 
provides  an  overview  of  the  work  summarizing  the  important  results.  Section  6.2 
similarly  summarizes  the  main  areas  where  work  remains  to  be  done. 

6.1    Summary  and  Conclusions 

This  study  focused  on  the  development  of  a  six  degree  of  freedom  (6  DOF)  robust 
sliding  controller  to  be  used  on  a  variety  of  UUV  designs  in  dynamically  difficult  regimes 
like  shallow  water  as  well  as  for  complicated  maneuvering  such  as  hovering.  As 
indicated,  such  operating  conditions  require  full  consideration  of  the  non-linearities  and 
coupling  inherent  in  the  UUV's  equations  of  motion  in  addition  to  the  parameter  and 
structural  uncertainties  posed  by  these  equations. 

The  hydrodynamic  theory  necessary  for  the  development  of  this  6  DOF  sliding 
controller  was  laid  out  in  Chapter  2.  Indeed,  the  main  thrust  of  the  development  was  the 
identification  of  a  particularly  useful  structuring  of  the  UUV  equations  of  motion  so  that 
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the  non-linear  control  techniques  used  in  Chapter  3  would  result  in  an  elegant  and 
powerful  controller.  An  important  relationship  between  the  vehicle-  and  earth-reference 
frames  was  established. 

Chapter  3  formulated  the  robust  sliding  controller  which  was  shown  to  be  stable 
-  assuming  full  6  DOF  control  authority  -  from  any  vehicle  configuration  except  at  ±  90 
degrees  of  pitch. 

As  full  6  DOF  control  authority  is  usually  not  available,  an  attempt  was  made  to 
develop  a  method  to  modify  this  sliding  controller  so  that  lesser  degree  of  freedom 
vehicles  (in  terms  of  available  control  authority)  would  perform  satisfactorily.  As 
demonstrated  with  the  4  DOF  21UUV,  this  method  -  weighted  least  squares  -  is  based 
heavily  on  the  non-minimum  phase  relationship  between  pitch/depth  and  yaw/trackline. 

Finally,  in  Chapter  5,  two  related  control  issues  -  buoyancy  control  and  wave 
disturbance  control/adaptation  were  briefly  discussed  and  their  connection  with  robust  6 
DOF  sliding  control  explored. 

All  developments  irt  this  study  were  extensively  simulated,  indicating  that  many 
of  the  ideas  presented  in  this  thesis  have  some  practical  use. 

6.2     Directions  for  Further  Research 

Although  a  considerable  amount  of  design  effort  has  been  expended  in  the 
development  of  the  robust  6  DOF  sliding  controller,  significant  work  remains  to  be  done 
before  it  can  be  practically  used  on  the  21UUV  or  similar  vehicles.  The  body  and 
hydrodynamic  coefficients  need  to  be  as  accurately  computed  as  possible  with  good 
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estimates  of  the  bounds  on  their  ranges.  A  dynamic  model  of  the  propulsor  needs  to  be 
formulated  and  incorporated  into  the  controller;  dynamic  models  of  the  control  surfaces 
can  also  be  incorporated  (or  the  A  matrix  values  in  the  sliding  controller  can  be  tuned 
down  where  appropriate). 

If  the  UU V  to  be  controlled  is  similar  to  the  2 1 UUV  in  terms  of  control  authority 
available  (i.e.  4  DOF)  then  it  is  important  to  verify  that  the  weightings  in  the  weighted 
least  squares  methodology.  If  the  controller  is  to  be  used  for  a  vehicle  designed  to  hover, 
then  the  D  matrix  in  the  equations  of  motion  should  be  extended  to  include  those 
hydrodynamic  terms  that  become  important  in  this  operating  regime. 

The  variable  buoyancy  control  ideas  of  Chapter  5  are  easily  implemented.  Also, 
the  disturbance  rejection/adaptation  ideas  in  this  chapter  need  to  be  incorporated  with  the 
results  of  an  adaptive  controller  developed  in  the  sister  study  to  this  thesis  -  Willy  [1994]. 
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Appendix  I 


21UUV  Body  and  Hydrodynamic  Coefficients 

Body  Coefficients   -   Assumed  5%  uncertainty 


w 

15882  N 

xG 

2xl0'6  m 

B 

varies 

yG 

0  m 

XX 

55.03  kg-m2 

zG 

.005  m 

=  I    = 

yy          *zz 

7100  kg-m2 

XB— Yb— ZB 

0  m 

m         = 

1619  kg 

Hydrodynamic  Coefficients  -  Assumed  20%  uncertainty 


Xu|u| 

= 

-33.69  kg/m 

X8s8s: 

=X6r5r 

= 

-6.89  kg/m 

xu 

= 

-41.5  kg 

X8a8a 

= 

-12.9  kg/m 

wq         ~-^vr 

= 

-1818  kg 

Xv§r=- 

Xw8s 

= 

5.25  kg/m 

Y  =Z 

1  V     ^w 

= 

-200  kg/m 

Xr8r= 

=Xq8s 

= 

-162  kg 

Yr=-Zq 

= 

770  kg 

^ht='^hs 

= 

11.5  kg/m 

Y-=Z« 

= 

-1619  kg 

M, 

5s    ^Sr 

= 

-355  kg 

Yr-z. 

= 

-121.5  kg-m 

K5a 

= 

.556  kg/m 

Mw=-Nv 

= 

849  kg 

MrSa 

= 

-17.2  kg 

Mq=Nr 

= 

-3066  kg-m 

MvSa 

= 

.556  kg/m 

M--N; 

= 

-121.5  kg-m 

Nq5a 

= 

14.7  kg 

M-=N; 

= 

-7255  kg-m2 

N\v8a 

= 

.080  kg/m 

Notes:  Notation  of  SNAME  [1950]  is  used;  for  example,  Xu|u|  is  the  coefficient  for  the 
term  Xu|u|  |  u  |  in  the  matrix  D(v)  of  (2.23). 

All  control  surfaces  are  assumed  to  have  ±20  degree  range  of  motion. 

The  propulsor  is  not  dynamically  modelled  as  its  design  (for  the  21UUV)  is 
largely  unknown.   Assumed  a  "perfect"  thruster  -  delivers  with  no  time  delays  - 
what  is  commanded. 
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Appendix  II 


Proof  of  the  Stability  of  the  6  DOF  Sliding  Controller 


A  Lyapunov-like  analysis  using  Barbalat's  Lemma  is  performed  to  demonstrate  the 
asymptotic  stability  of  the  6DOF  controller  of  Chapter  3  from  any  point  in  the  vehicle 
state-space  (except  for  the  singularity  at  pitch  angles  of  ±  90  degrees).  For  a  more 
complete  treatment  of  Lyapunov  stability  theory,  the  reader  is  referred  to  texts  such  as 
Slotine  and  Li  [1991]. 

From  (3.8),  the  Lyapunov  function  chosen  for  the  underwater  vehicle  equations  of 
motion  in  the  controller  design  is: 


V{t)  =  VzsTMs  >  0 


n 


with  time  derivative  from  (3.19): 


6 

V(t)  *  (-£e.|s.|  -sTDs)  *  0 


i=i 


The  latter  relationship  implies  that  V(t)  <  V(0)  and,  thus,  s  is  upper  bounded  since  M^ 
is  positive  definite.  From  (3.5)  fj  and  fj  are  bounded  and  since  the  desired  trajectories 
r\d,  r\d  and  r\d  are  bounded  the  reference  trajectories  r\r  and  r^  and  the  actual  trajectories 
r)  and  r}  are  bounded  from  (3.6). 

Combining  the  system  dynamics  of  (2.26)  with  (3.5)  yields: 

Thus  s  is  bounded  since  all  the  matrices  (except  at  pitch  angles  of  ±  90  degrees)  and 
vectors  are  bounded,  and  from  (3.5)  it  follows  fj  must  also  be  bounded.  This  implies  that 
V(t)  is  bounded. 

Application  of  Barbalat's  Lemma  then  leads  to  the  conclusion  that  F(t)->0  as  t-»oo, 
which  implies  that  the  tracking  error  s  and  thus  fj  and  fj  converge  to  zero. 
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